#ifndef FILTER_UTILS_H
#define FILTER_UTILS_H

#include <queue>
#include <Eigen/Core>

class MovingAverageFilter {
public:
    MovingAverageFilter(int window_size);
    Eigen::Vector3d apply(const Eigen::Vector3d& new_position);

private:
    std::queue<Eigen::Vector3d> position_queue;
    int window_size;
};

#endif // FILTER_UTILS_H